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Collision avoidance 

No Avoidance: 
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is hard to perfect 

No Anticipation: 


Reynolds Flocking Crowd 
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Today's Topics 


Geometric Optimization 
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Data-Driven Forces 
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Optimal Reciprocal Collision Avoidance 

(ORCA) 

• Formulate as an optimization 
problem 

• Assume agents reciprocate 

• Locally optimal solution can 
be computed for each agent 
in parallel! 
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Velocity Space 


• Each agent plans in velocity space 



World-Space 


velocity-space http://gamma.cs.unc.edu/RV02 
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Extending ORCA & VOs 

• ORCA can be extend to oriented dynamics 

• Useful for formations 
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Success with ORCA & Vel. Space 

• Developers have incorporated this ideas 



Disney/ETH, 2012 


© Relic Entertainment, 2012 


Dan Brewer's 
AI Summit Talk 
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When ORCA goes wrong 

• Locally optimal is not really optimal 

• Agents can be "afraid" 
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Turning to Humans... 

• How do humans do it? 

• Lots of data exist! 

• What are the statistical trends 
in pedestrian trajectories? 

• Can we quantify human 
collision-avoidance interactions? 
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Crowd Energy 

• Navigation discomfort can 
be quantified 

• Function of time-to-collision (r) 



Time-to-collision (s) 



[Karamouzas et al. 2014] 
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Crowd Energy Law 


• Energy = k * log(l / frequency ) 

• Energy falls off inversely proportional to t 2 
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Visualizing Crowd Energy 


• Energy is defined 
inside the VO 

• Agents ignore 
neighbors not on 
a collision course 

• Energy increases 
with higher speeds 
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From Energy to Forces 

• The spatial derivative 
of energy gives 
avoidance forces 

Vy 2.0 

F = -Vk/r 2 

1.0 - 

The forces can be 
computed analytically! 
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Computing Forces 

• Analytical solution to forces 


def dE (pa, pb, va, vb, ra, rb) : 

w — pb - pa; v — va - vb; radius — ra+rb 
a = v.dot(v); b = w.dot(v); c = w.dot(w) - 
discr = b*b - a*c; 

if (discr < 0): return np. array ([0, 0]) 

discr = sqrt (discr) ; 
t = (b - discr) / a; 



Compute 
TTC (t) 


radius* radius ; 


if (t < 0): return np. array ([0, 0]) #no collision = no force 

return k* (v - (v*b - w*a) / (discr) )/ (a*t**2) * (2/t) 

#k is a scaling constants 
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Computing Forces 

• Analytical solution to forces 


def dE (pa, pb, va, vb, ra, rb) : 

w — pb - pa; v - va - vb; radius — ra+rb 

a = v.dot(v); b = w.dot(v); c = w.dot(w) - radius*radius ; 
discr = b*b - a*c; „ 


Compute 

Energy 


if (t < 0): return np. array ([0, 0]) #no = no force 

return k* (v - (v*b - w*a) / (discr) )/ (a*t**2) * (2/t) 

#k is a scaling constants 


if (discr < 0): return np. array ([0, 0]) 

discr = sqrt (discr) ; 
t = (b - discr) / a; 
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The Full Simulation 

• Main forces: Goal force & Avoidance force 
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The Full Simulation 

• Main forces: Goal force & Avoidance force 


for i in range (num) : 

F [i] += (gv [i] -v [i] ) / . 5 

F[i] += l*np . array ( [rnd. uniform (-1 1 .)/ rnd. uniform (-1 1 .)] ) 

for n, j in enumerate (nbr [ i ] ) : #j is neighboring agent 
dEdx = dE (p [i] ,p [ j ] , v [i] , v [ j ] , r, r) 

FAvoid = -dEdx 
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The Full Simulation 

• Main forces: Goal force & Avoidance force 


for i in range (num) : 

F[i] += (gv [ i ] -v [ i ] ) / .5 

F[i] += l*np . array ( [rnd. uniform (-1 1 .) , rnd. uniform (-1 . , 1 .)] ) 

for n, j in enumerate (nbr [ i ] ) : #j is neighboring agent 

dEdx = dE(p[i] ,p[j] ,v[i] ,v[j] ,r,r) 

FAvoid = -dEdx 
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The Full Simulation 

• Multiple forces: 

• Goal directed motion 

• Collision avoidance 

• Follow player forces 

• Grouping forces 
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Practicalities 

• Ignore far away collisions (> 3s) 

• Clamp to a max force 

• Choose a small timestep (e.g., 5ms) 

• Use multiple simulation timesteps per 
rendering frame 


http://motion.cs.umn.edu/PowerLaw 
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Results 
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Complex Crossing 
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Dense Interaction 
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Heterogeneous Speeds: 
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Comparison to ORCA 

• Less timid agents k 


TTC 

Forces: 
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Take-Aways 

• Two methods, 
many similarities 


• Both methods are: 

• Fast & Scalable to 1000s of agents 

• Collision free 

• Anticipatory 
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Take-Aways \ 

(Differences) 

ORCA: 

• Strong guarantees 

• Even with large timesteps 

• Flexible framework 

• Difficult to implement 

• Takes too much control 
over velocity 
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TTC Forces: 

• May choose a colliding vel. 

• Collision free 

• ... but only for small 
enough timesteps 

• Natural to tweak forces 
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Conclusions 

• ORCA provides guarantees 
is very extendable 

• Data-driven TTC forces 
work well in practice 

• TTC forces are simple to 
implement with good 
results 
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Compact Sim. 

• Goal force 

• Avoidance force 

. F = —V* / T 2 

t/ 

• vel += F*dt; 

• pos += vel*dt 
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Compact Sim. 

► Vector Library 

► Scene Initialization 

► Animated Gif Header 

► Rasterizer 

► The actual forces 

► Simple Integration 
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My Business Card <§ 


• 1,500 char crowd sim 
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